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(57) Abstract: The present invention discloses a position determination device (50) for 
an autonomous apparatus (1). The position determination device (SO) comprises means 
(54) for dividing up driving of the autonomous apparatus (1), based on rotation veloc- 
ities of the driving wheels (17, 18), into different driving modes (40a-40u), in which 
the actual track width (30) of the apparatus (1) is substantially constant The device 
(50) further comprises calibration means for calculating the actual track width (30) for 
each one of the driving modes (40a-40u). The calibration means performs a calculation 
method, in which the apparatus (1) is aligned in an initial direction and turns in one 
of the driving modes (40a-40u). The actual total turning angle of the apparatus (1) is 
measured together with the wheel rotations of the driving wheels (17, 18). Calculation 
of die actual track width (30) is peifoimed on the basis of this actual total turning angle 
and the wheel rotations. 
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METHOD AND DEVICE FOR DETERMINING POSITION OF AN AUTONOMOUS 

APPARATUS 

TECHNICAL FIELD 

5 The present invention generally relates to autonomous apparatuses, and in particular to 
devices and metiiods for inq)roving position determination thereof. 

BACKGROUND 

10 Autonomous apparatuses such as autonomous or robotic vacuum cleaners and other 
self moving devices are well known in the prior art, for exan^le as disclosed in tibe 
International Patent Applications WO 97/41451 (US Patent No. 5,935,179) and WO 
00/38028, respectively. Such autonomous surface treatment apparatuses generally 
have a main body, being supported on or by a number of motor-driven wheels or 

15 rollers and means for surface treatment such as rotating brushes in combination witii 
a vacuum cleaning device. Further, a sensing system, usually in combination with 
transmitters, is provided for guidance, navigation and obstacle detection. The sensing 
system generally sweeps around the horizon in analogy, for example, with a ship 
radar. A microprocessor together with appropriate software controls the transmitters 
20 and motors of die device. Normally, the microprocessor also receives input data 
from the wheels and the sensing syst^ for the purpose of position information and 
localization of wall lunitations as well as potential obstacles. This input data is then 
typically used as the basis for navigating the autonomous apparatus so that it, for 
instance, will be able to perform a cleaning function or other surfece treatment 
25 function according to some predetermined strategy and at the same time avoid 
colliding with different obstacles, which may be arranged in the field of operation, 
besides avoiding collisions with lunitations such as walls or the like. 

Typically, an autonomous aj^aratus orients itself at any time withm its permitted 
30 motion area defined by a map on the basis of information obtained from the sensing 
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system. Furthennore, the map is typically generated and updated by the autonomous 
apparatus itself during its movements. It is often vital for the apparatus to obtain an 
as accurate map as possible, as well as an exact positioning and orientation within 
the area defined by the map, to be able to perform its operations. Several systems for 
position detemunation of autonomous £^paratuses have therefore been developed, 
based on different techniques of prior art. Apparatus contained internal systems such 
as distance sensors in connection to wheels, have proven to be most cost effective. 

The internal position determmation systems usually are composed of wheel sensors 
registering the rotational motion of the wheels. In order to determine how ^ the 
apparatus has travelled since previous registration, the information from the wheel 
rotations is used together with the wheel diameter. This can be done with a 
reasonable good accuracy when the surface is not too soft, smce tibe elective wheel 
diam^ thai can be assumed to be constant. When the surface is sUppecy or soft, 
the apparatus may skid and/or the wheels may spin. The calculated travelled distance 
based on the wheel rotations is then incorrect compared to the actual distance 
travelled by the apparatus. In order to correct for this slippage, a position calibratioa 
method has to be performed. Such a method is disclosed m the US Patent 5,794,166. 
The method includes prediction of a cumulative overall slippage of the apparatus 
occurring when the apparatus travels from a starting point to a destination point 
along an imaginary path. This imaginary path includes a rotation of the apparatus at 
the startuig pomt by a first rotation angle so that the apparatus is dkected towards the 
destination point. The apparatus then travels forwards from the staring point to die 
destination pomt. Finally, a rotation of the apparatus at the destination point is 
performed that aligns the apparatus with the reqmred rotational position of this point 
Furthermore, an overall slippage per wheel based on at least one distance dependent 
prescribed slippage is calculated. To determine this, the distance between the 
effective contact points between the two driving wheels and the surface onto which 
the apparatus is to operate, defined as the "track width" of the autonomous 
apparatus, must be known. The track width is furthermore utilized for calculating die 
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rotational angle of the autonomoiis apparatus, as the apparatus moves along the 
imaginary path. 

A problem with the method disclosed m US Patent 5,794,166 is that the actual track 
width of the autonomous apparatus varies dq)ending on the surface, as well as on the 
type and direction of the turn. The reason for this is both that the effective contact pouit 
varies and that the wheel suspension is not totally rigid. As the effectwe contact point is 
displaced during tummg of the apparatus, the actual track width will change, and the 
slippage calculation method in US Patent 5,794,166 will fail and an erroneous rotation 
of the apparatus is performed. 

SUMMARY 

An object of the preset invention is to provide an accurate position determination 
method for autonomous apparatuses and devices dierefore. Anodier further object of 
the present invention is to mqnrove the position determination usmg a calibration 
method for catoulatmg an actual track width of the ^aratuses and devices therefore. 

The above objects are achieved by devices and methods according to the enclosed 
claims. In general words, an auton(Hn(ms apparatus is equipped with a positmn 
determination device for position determination and localization during its operation. 
The position device conqmses encoders for generating signals corresponding to wheel 
rotations of the drivmg wheels. The position change and the heading of tiie apparatus 
since the previous recording are obtained from these v/bsei rotations, in combination 
with the diameter of tiie wheels and the track widtii of the apparatus. The motion of flie 
autonomous apparatus is in the present invention divided up into difSsrent driving 
modes, each one associated widi a sq)arate actual track widtii. Each diiving mode is 
preferably defined m such a way that tiie trads: width of the aj^aratus is substantially 
constant witii tiiat drivmg mode. 
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The position detmnination device further comprises calibration means for calculating 
the actual track width associated with each one of the driving mode used by the 
autonomous apparatus. The calibration means in turn comprises means for aligning the 
apparatus in an initial direction decided by the qperator, or an internal or external 

5 source. The apparatus is then caused to turn in the driving mode, whose actual tiaxk. 
width is to be calculated. As the apparatus is turning, a means determines the total 
tummg angle of tiie {apparatus, based on an external reference or some internal device. 
Encoders register the corresponding wheel rotations during tiie turning. Preferably, 
from the wheel rotation and a trai^orary track width, an expected tummg angle is 

10 calculated. A difference between the actual and die expected turning angles is then 
determined, and the actual track width is calculated as a correction of the tenq)Qraiy 
track widtii based on the angle difference. 

The major advantages of the present invention come as a result of the division of the 
15 operation of the autonomous apparatus mto different driving modes, in which the actual 
track width is substantially constant. This gives a much more accurate and reliable 
position determination conopired to methods accordmg to the prior art, based on one 
track width. 

20 BRIEF DESCRIPnON OF THE DRAWINGS 

The invention, togetiiCT witii further objects and advantages thereof, will be best 
understood by reference to die foliowmg description taken together widi the 
accompanying drawhigs, in ^ch: 

25 

Fig. 1 illustrates a top view of an embodiment showing a vacuum-cleaning robot 
equipped according to the present invention; 

Fig. 2 is a side view of the autonomous apparatus according to Fig. 1; 

30 
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Fig. 3 is a lEioiit view of tiie autonomoiis apparatus accoidiog to Fig. 1 ; 



Fig. 4 illustrates a hardware block diagram of tlie embodiment of Fig. 1; 

Fig. Sa, 5b and Sc illustrate different possible ways of defining driving modes of an 
autonomous apparatus according to tiie present invention; 

Fig. 6a and 6b illustrate the prmcqiles of associating the contact points between the 
wheels and the sur&ce and an actual track width; 

Fig. 7 is a detailed view of tiie hardware block diagram of Fig. 4 illustratmg the 
hardware and the software mainly used by the present invention; 

Fig. 8 illustrates a flow diagram of the position determmation method of the present 

invention; and 

Fig. 9a and 9b are flow diagrams of die position calibration method of the present 
invention. 

DETAILED D£SCR]FnON 

Throughout ^ drawings, die same reference characters will be used for corresponding 
or similar elemaits. 

In the foUowmg, the invention will be described with reference to a particular exanq>le 
of an autonomous s^aratus, namely an autonomous vacuumrcleanmg device. It 
should, however, be understood tiiat the invention is not limited diereto, and that the 
invention is applicable to various otiier autonomous ^aratuses, such as transport 
vehicles in manufacturing environments, movable multi-purpose robots and robotic 
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lawnmowers, as well as autonomous surfece treatment devices for sweeping, 
brushing and floor polishing. 

In the present disclosure, "speed" refers to the absolute value of "velocity", which 
5 has both a magnitude and a direction, i.e. can be either positive or negative. 

General features 

Fig. 1 illustrates in a three-dimensional top view of an ilhistrative embodiment of an 
autonomous vacuum-cleaning device 1, which by itself will move on a floor and 
10 vacuum-clean a room. In the front portion there is arranged an ultrasonic system. The 
ultrasonic system CQnq)rises a strip-shaped ultrasonic transmitter 10 having a length 
covering of the order 180" of the front perimeter of the device as illustrated in Figs. 2 
and 3. As seen in Fig. 2, the transmitter 10 with strip-shaped elements is mounted 
above a lower first row of microphone units 12. Above the strq>-shaped transmitter 
15 elements a second row of microphone units 13 is localized. The ultrasonic echo sensor 
microphones 12 and 13 together wifli the transmitter 10 form an ultrasonic sonar 
system for the navigation of the device. In the ilhistrative embodiment die transmitter 
transducer is countersinked in a forward directed, movable hamper unit 16. The 
bunq)er 16 controls a left and a right bunq)er touch sensor, either one bemg actuated if 
20 the hamper makes contact with an obstacle. In Figs. 2 and 3 it will be seen that the 
device has two diametrically positioned wheels 17, 18. Each wheel 17, 18 is 
independently driven by a sq)arate motor preferably equipped with a gearbox. The 
driven wheels 17 and 18 will enable die device to also rotate around its own symmetry 
center or around either wheel 17, 18. On the axis from each motor, driving the 
25 respective wheel 17 and 18, a respective quadrature sensor is mounted. Quadrature 
signals from the sensora are connected to a built-in microprocessor controlling the 
device. The signals flx)m these sensors, or equivalent devices will be used for obtaining 
a dead count for estimating the distance of travel. This is described more in detail 
below. Optional wheels support the back of tbe device. The device is generally 
30 balanced with a slightly larger wei^ on die rear half of die device, carrymg for 
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instance the batteries, sudi that it will always move with all wheels in contact with Hie 
floor. Due to this balancing the device may easily climb the edges of floor carpets and 
the like. 

Further, the autonomous device may advantageously be equipped widi Hall effect 
sensors, preferably one in front of each wheel, for detection of a magnetic fence and/or 
one or more magnetic strips in connection with the automatic charging station used for 
charging the device. The magnetic fence can be used to restrict the movonent of die 
device. For example, the f&oce can be placed so that device does not fall down the 
stairs. It can also be placed so as to sq>arate rooms without having to close die door, hi 
this way, it is possible clean one room at a time, which has tamed out to be an effective 
way of cleaning. 

Fig. 4 is a hardware block diagram of the device according to Figs. 1, 2 and 3. The 
haidmie basically consists of a processor board, which is configured to drive the 
ultrasonic: transmitter and the corresponding microphone based receiver system, the fan. 
and brush motors, die two wheel motors, as well as odier CQmponraits of the 
autonomofus vacuumrcleanmg device. The processor board is essentially built around a 
date processor such as the MC68332 from Motorola Inc. 

The sonar localization sensing system formed by the transmitter and receiver system 
is utilized by the autonomous vacuum-cleanmg device for obstacle detection 
purposes, such as detecti(m of obstacles in the path of the moving device, pii^ointing 
the exact location of the nearest obstacle. The processor controls the transmitter and 
receives mpat data from the receiver system for subsequent evaluation. 

The processor also controls the motor for the rotating brush as well as the motor for 
the fan, wherein the fan generates the necessary vacuum for the general fimction of 
the vacuum cleaner. Air from the fan motor is additionally in a known manner 
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Utilized for cooling purposes and the air is exhausted at a gilled outlet at the top of 
flie device. 



The processor is controlled by software stored in a number of different types of digital 
5 memories for exanople of type FPROM, RAM or EEPROM, which are all well known 
to a person ^miliar to conq>uter techniques. Additionally die processor has its own 
cloddng system CliC also known from the prior art. 

The system as illustrated in Fig. 4 fruther comprises a number of switches, two bmnper 
10 switebes and two tilt switches. Ihe two bumper switches L-Bumper, R-Bunq)er are 
connected to two TPU ir^ut pins worMng in discrete I/O mode, and are used as a 
complement to the sonar system for detection of collisions with obstacles. The tilt 
switches are used to detect whether the device is leveled with (he floor or tilted. 

15 The system also inchides a number of switches for input commands from a control 
panel. For example, this enables the user to turn die vacuum cleaner on and off, and to 
select one of a nuniber of cleaning programs. 

Signals representative of the magnetic fields that are semed by die Hall sensors are fed 
20 to the processor via die A/D-converter and processed thereby to allow detection of the 
automatic diarging station and the magnetic fence. The offset voltages of die analogue 
Hall sensors may vary with time, tenqierature and mdividual sraisors, and therefore a 
zero field referoice point is constantly recateulated widi a skm averagmg filter and 
adjusted based on pulse widdi modulated signals fix)m the processor. 

25 

in order to detect malfunctions, various signals are continuously measured and fed to 
die processor for evaluation, dth^ directiy via the A/D-converter or first timnig^ the 
multiplexer MUX and then via the A/D-converter. 
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The wheel motors for driving the apparatus are separately controlled by pulse-width 
modulated signals of S kHz generated by two more channels from the Tune 
Processor Unit in the main processor. In order to detect how much each wheel has 
rotated, the quadrature encoders mounted in connection with the wheels generate 
5 quadrature signals that are connected to Time Processor Unit (TPU) inputs of the 
MC68332. The quadrature signals are processed by the processor to provide position 
information by keeping track of the distance of travel and preferably also the rotation 
of the autonomous device during movement, which will be described in more detail 
below. 

10 

Position determination 

In Fig. 6a, a position determination of the autonomous apparatus 1 according to the 
present mvention is performed using signals from encoders SI, 52 located ui 
connection to the driving wheels 17, 18. These encoders 51, 52 register the rotation 

15 of respective wheel 17, 18 and the signals are then outputted to a microprocessor. 
The microprocessor calculates the position change of the apparatus 1 since previous 
registration by combining the wheel rotation signals witii information of the wheel 
diameters. In a first onbcdunent of the present invention the encoders 51, 52 are 
made of Hall sensors generatmg a quadrature signal in response to rotation of a 

20 magnetic disc 55 mounted in connection with the wheels 17, 18. The magnetic discs 
55 are discs divided up into a number of sectors with different magnetic directions. 
As the discs 55 rotate the encoders. 51, 52 register the change in magnetism and can 
thereby measure the rotation of respective wheel 17, 18. Other embodun^its are 
possible, such as slotted disc encoders and related devices. 

25 

The signals from the encoders 51, 52 are not only used for determining travelled 
distances but also for calculating the heading of the apparatus 1 during its movement. 
Tu rning of the autonomous apparatus is given by: 
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10 



15 



_ DistRight - DistLeft ^ 180 



TrackWmh ic 

where Aa is the turning angle in degrees of the apparatus 1 since previous position, 
DistRight and DistLeft is the distance traveled by the right and the left wheel, 
respectively, and TrackWidlh is the actual track width 30 of the apparatus 1 . Thus, 
to determine die heading of the apparatus 1 , in addition to the wheel rotation signals, 
the actual track widdi 30 is needed. The problem is that the track width 30 of the 
autonomous apparatus 1 varies depending on the surface, as well as on the type and 
direction of the turn. The motion of the apparatus 1 is therefore in the present 
invention separated mto different driving modes, in which the track width 30 is 
substantially constant or only varies betvveen acceptable limits. Figs. Sa, 5b and 5c 
illustrate how such driving modes 40a-40u are defined by the rotation velocities of 
the drivmg wheels 17, 18. In respective Fig., a coordmate system, in which the x- 
axis rq>reseDts rotation vdodty of the left wheel and rotation velocity of the right 
wheel is represented by the y-axis, is illustrated. Which wheel is defined as die left 
wheel or the right wheel does not matter as long as the deflmtion is used consistently 
throughout the entire procedure, i.e. there is no risk for mix-up between die two 



wheels. 



20 the embodiment of the present invention illustrated in Fig. 5a, the driving modes 
> 40a-40i are defined by a respective range of ratios between die rotation velocities: 



^^VelBightWheel^^ 
VelLeftWheel 



25 where VelRightWheel and VelLeftWheel are the velocities of the two driving wheels 
17, 18, respectively, and A and B are the lunits, within which the quotient associated 
with die drivmg mode 40a-401 is to be defined. This way of defining drivmg modes 
divides the coordinate system into sectors, such as 40a in Fig. 5a. The quotient will 
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be the same if the magnitudes of the velocities of the two wheels are the same but the 
directions are different. If the ratio is the single defining parameter, driving forwards 
with both wheels and driving backwards with die same rotation speed of respective 
wheel are also defined, m this embodiment, as the same driving mode. In Fig. Sa, 
sectors 40a and 40b are e.g. then associated with the same driving mode. However, 
additional defining parameters, such as the sign of one of the velocities, may also be 
used. The sectors 40a and 40b may then constitute separate driving modes. 

Fig. 5b illustrates another embodiment for defining driving modes 40m-40p of die 
present invention. Hie driving modes 4Om-40p are defined in that the rotation 
velocity of one or both wheels is within a predetermmed velocity range. The rotation 
velocities are, thus, limited by an upper rotation velocity lunit and/or a lower 
rotation velocity limit. This can be applied for each wheel mdependoitly, 40m or 
40n, or simultaneously for both wheels 40o. In die latter case a more precise division 
of drivmg modes is obtamed. For some operations it may, however, be sufficient to 
base the driving mode definition on the rotation velocity of only one wheel. The 
driving mode 40p iUustrates the use of indefinite velocity range. 

The drivmg modes iUustrated in Fig. 5b should only be interpreted as exaniples of 
possible driving modes. In a preferred embodiment, the driving modes should be 
complementary and together cover all allowed motion patterns. 

Fig. 5c illustrates yet another embodiment for definmg the drivmg modes 40q-40u of 
die present invention, which today is ccmsidered as the most preferred embodiment. 
This definition divides the drivmg operation of die s^tparatus 1 into five drivmg 
modes, of which diree 4Qr, 40t, 40u correspond to distinct velocity ratios and two 
40q, 40s correspond to ranges of rotation velocity ratios. 40r is the driving mode 
used for forward travel, where the rotation velocities of the two driving wheels 17, 
18 are the same. Here, ai^ associated actual track widdi may be used, smce die 
apparatus, at least ideally, does not turn. A coiiq)ensation for unintentional turns 
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may, however, optionally be present. 40t and 40a illustrate driying modes turning 
tht apparatus around its own axis on the spot in a respective direction. The 
magnitudes of the rotation velocities of the wheels are the same but the directions of 
rotation are opposite, m 40u the right wheel is rotating forwards whereas the left 
5 wheel is rotating backwards. The opposite is true for 40t, where the left rotates 
forwards and tibe right wheel rotates backwards. In order to turn while drivmg 
forwards, the two driving modes 40q and 40s are needed. 40q represents a mode 
involving turning the apparatus to the left and 40s represents a mode turning the 
apparatus to the right. In the former driving mode, 40q, the right wheel is rotating 

10 forwards either alone or m combmation with forward rotation of the left wheel. The 
rotation speed of the left wheel has, though, to be lower than the rotation speed of 
the right wheel. The same is true for 40s except that it is the left wheel that rotates 
alone or fttster than tiie right wheel. In this definition of driving modes, the apparatus 
is never allowed to move backwards. It instead turns on the spot and then moves 

IS forwards. Its movement is, thus, limited to the five different driving modes, which 
are sufficient to cover Hhs allowed motions used during operation of the autonomous 
apparatus 1 . A backward motion may, however, be used at special occasions, e.g. 
when the apparatus encounters an obstacle or a magnetic fence. If such motion is 
used, it is then preferably straight, whereby there is no track width dq)endence. 

20 

The motion of the autonomous apparatus 1 is, as mentioned above, generally divided 
up into different driving modes 40a- 40a, m which the track width 30 may be 
considered as substantially constant. Figs. 6a and 6b illummate the need for this 
division. 

25 

Referring to Fig. 6a, this is a view of principle of the lower part of an autonomous 

apparatus 1 showing the effective contact points 31, 32 between the driving wheels 
17, 18 and a surface 33, when the apparatus is driving, forwards with the same 
rotation speed on both driving wheels. The effective contact points 31, 32 of 
30 respective wheel are typicdHy, in this driving mode, located in the center of the parts 
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of the lateral aieas of tiie wheels 17, 18 that are in contact with the surface 33, as 
illustrated in Fig. 6a. These effective contact points 31, 32 define the actual track 
width 30 of the apparatus. 

5 In Fig. 6b, the actual track width 30 in a different driving mode is shown. In this 
drivmg mode the apparatus is turning right while driviog. The effective contact point 
32 of the driving wheel in the direction of the turn, i.e. the right wheel 18, is 
displaced from the center of the lateral area as in Fig. 6a towards the side facing the 
turning direction. This displacement of contact points changes tiie actual track width 
10 30 of the apparatus, resulting in a noticeably different track widtii compared to the 
driving mode associated with Fig. 6a. 

Figs. 6a and 6b should merely be viewed as illustrative examples showing the 
dependence of the track width 30 iqxm the driving mode of the apparatus 1. The 
15 actual track width 30 and the effective contact points 31, 32 will change further at 
other driving modes but the spirit of die driving mode concept should be clear from 
the Figs 6a and 6b. 

Fig. 7 illustrates a part of the hardware block diagram of Fig. 4 in more detail, 
20 omittiag the parts not directiy used for position determination purposes, hi order to 
move die autonomous apparatus 1, pulse-width modulated signals (PWM) are 
ou^utted from the Time Processor Unit in Ute microprocessor 21 . These PWM 
signals control the sailed voltage to respective driving motor and thereby control 
the rotation speed and direction of re^ective wheel. As mentioned above, encoders 
25 51 , 52 register the wheel positions, generating quadrature signals that are forwarded 
to die microprocessor 21, and corresponding velocities are determined. In order to 
determine the position change of the apparatus 1 since previous recordmg the actual 
track width 30 and die driving mode 40 of the apparatus 1 have to be determined. In 
the digital memories 20, software used for position determination, is stored. Based 
30 on the wheel positions, encoded in die quadrature signals, determination means 54 in 
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the digital memories 20 determines the present driving mode 40 of the apparatus 1 
by use of wheel rotation velocities. From this driving mode 40 the associated actual 
track width 30 is obtained, which is used in the subsequent position calculations. 

5 Before the actual position calculations it has to be determined which track width to 
use. The driving mode and therefore also the definition of driving modes have to be 
known. It might be, from operational point of view, most suitably to have several 
different definitions of driving modes, such as some of the definitions of Figs. Sa, Sb 
and 5c. The operator can then switch between delBnitions of different sets of driving 
10 modes when i.e. the surface changes or when the autonomous apparatus is to 

perform a new operation where the former driving mode definition is not perfectly 
representative. Whichever driving mode definition used, the actual track width has to 
be determined and associated to each driving mode. This is m the present uiventiaii 
preferably performed by a calibration method, which is described further below. 

15 

Once the actual track width is known, the position change is calculated by calculation 
means 53 stored m the digital memories 20, which are loaded and executed in the 
microprocessor 21. The travelled distance is calculated using the wl^I rotations and 
the diameter of respective wheel, whereas the heading is given by equation (1). By 

20 startmg in an initial well defined position and calculating the position change at some 
intervals as the apparatus moves, and storing tiiis information in the digital 
memories, the apparatus may keep track of its movement during its operation and 
thus of its present location. This information is used by e.g. surface treatment 
autonomous apparatuses together with a map over die area of operation, to know 

25 which parts of the operation area that have been treated and which parts that are 
untreated. 

In order to determine the actual track widtii 30 of respective driving mode 40a-40u, a 
position calibration means of die present mvention is preferably used. Firstiy 
30 aligning means 22 aligns the autonomous s^aratus 1 in an initial direction. The 
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aligning means 22 controls tibie driving means 60 via the PWM signals from the 
microprocessor 21 so that the apparatus 1 turns and possibly also moves to face a 
direction selected by the aligning means 22. The aligning means 22 could preferably 
con^)rise magnetic detectors 23^ 24, e.g. Hall sensors, detecting a magnetic field that 
5 is provided to durect tb& apparatus 1 in the correct dhrection. The magnetic field may 
originate from magnetic stripes or other magnetic sources, such as the magnetic 
fence and/or one or more of the magnetic strips in connection with the automatic 
chargmg station mentioned above. Other embodiments are also possible; the aligning 
means 22 may comprise push buttons that the operator pushes when the i^aratus 1 
10 is to calculate the track width 30. The initial direction may then be the direction die 
apparatus is facing when the button is pushed so no turning before the actual 
calibration is necessary. Alternatively, an external signal from some source may 
trigger the calibration method and the aligning means 22 then conq)rises a receiver, 
sensitive to the external signal. 

15 

Once the apparatus 1 has been aligned in the initial direction, the microprocessor 21 
sends PWM signals to the driving means 60. The driving means 60, in turn, causes 
the apparatus 1 to turn in the driving mode 40a-40u associated with tiie actual track 
width 30 to be determined. If tiie apparatus moves accordmg to the driviog mode 40r 

20 ni Fig. 5c, it is actually moving sttaight ahead, i.e. not turning. In this drivmg mode 
40r, the actual track width 30 is in &ct arbitrary, e.g. given by the distance between 
the wheels and no calibration is necessary. On die other hand, for otiier possible 
drivmg modes an actual calculation is necessary to obtain tiie correct trade width. 
The acmal total turning angle of the apparatus, during tiie tummg m the selected 

25 drivmg mode, is then determined by reference means 80. The refinance means 80 
uses some internal or external reference for obtaining the actual turning angle. 
Gyros, sensitive to changes in travelling dnection, could be used as an internal 
reference for calculatmg the total turning angle of the apparatus 1. External 
references could be a magnetic field sensed by the magnetic detectors 23, 24 in the 

30 aligning means 22 or other magnetic detectors. Just as for die mitial aligning other 
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external signals, such as a signal beacon or another source somewhere in the area of 
operation, may be used as a stationary reference. Doing the turning in the selected 
driving mode, the angle relative the reference changes and the reference means 80 
can thereby calculate the total turning angle of the apparatus. The apparatus may 
preferably turn a predeteimmed total turning angle, which e.g. could be determined 
by the operator. The wheel rotations corresponding to diis tummg, predetermined or 
not, are simultaneously registered by the encoders 51, 52. By using the wheel 
rotations and the total turning angle, the actual track width 30 of the driving mode 
40a- 40u can be calculated by means of a calculation means 70. From the wheel 
rotations, an e^cted total turning angle of the apparatus is preferably calculated in 
an expectation means 71, based on a temporary track width. This temporary track 
width may be the track width used during driving straight forward, 4Qr in Fig. 5c, 
die nominal track width or a previously calculated track width. Difference means 72 
calculates a possible difference between the actual total turning angle, determined by 
tihe reference means 80, and the expected turning angle, obtained from the 
expectation means 71. Based on diis difference, a correction of the temporary track 
width is determined by correction means 73. The temporary track widdi is, dms, 
calibrated to correspond to the actual track width 30 of the apparatus 1. 

It is also possible to caUbrate the apparatus by rotating the wheels a predetermined 
number of rotations and simply registenng the corresponding actual turning angle. 
Sunilar calculations as above are used to obtain the corr^ actual tummg angle of 
the apparatus. 

The track widths may, usmg the method above, be calculated for all possible driving 
modes at one instance, e.g. at the start of die operation. The information of the 

driving modes and associated track widths may then be stored in the digital 
memories 20 of the autonomous apparatus 1 . As the driving mode changes during 
the operation, die respective stored actual track width is used for position 
determination. This stored data can be used for longer-term operations so that 



wo 02/075469 PCT/SE02/00420 

17 

calculations are only perfoimed if a new, until now not used, driving mode is 
encountered, and not every time the apparatus is started. Another possibility is to 
calculate the track width as the apparatus changes driving mode. In this way the 
calibration metibod has to be p^ormed at least once for every new driving. The 
5 information may be stored in the memories 20 for later uses. However, preferably 
the calibration is performed regularly or when there are indications of changes in 
motion conditions. 

Fig. 8 illustrates a schematic flow diagram of die position determination metiiod of 
10 the present invention. The metiiod starts in step 100. In step 101, a wheel rotation is 
determined for the two driving wheels. A driving mode is then in step 102 
determined, based on the wheel rotations. In step 103, the position diange since 
previous calculation is calculated, based on an actual track width, associated with the 
driving mode. Finally, the position determination method is completed in step 104. 

15 

The calibration method of the present invention is briefly described in Figs. 9a and 
9b. The calibration procedure starts in step 200. In step 201, the apparatus is aligned 
in the initial direction, decided by the operator or some external or internal iiq>ut. 
The apparatus is then in step 202 caused to turn, in the driving mode associated with 
20 the actual track width to be calculated. The actual tmiiing angle is determmedmste^ 
203, using an external reference or an internal means. In step 204, the correspondmg 
wheel rotations are roistered preferably by encoders in connection with respective 
wheel. The actual track width of the present drivmg mode is calculated in step 20S, 
before the method is completed in step 209. 

25 

Fig. 9b describes a preferred manner to accomplish tiie calculation step 205 m more 
detail, hi step 206, an expected total turning angle is calculated based on tiie wheel 
rotations and a temporary track width. The calculation continues in step 207, where 
a difference between the actual and the expected total turmng angles is determined. 
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In step 208, the actual track width is calculated as a correction of the temporary 
track width using the difference in step 207. Finally the method is ended in step 209. 

It will be understood by a person skilled in the art that various modifications and 
S changes may be made to the present invention witiiout departure from the scope 
thereof, which is defined by tb& appended claims. 
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CLAIMS 

1. A position determination method for an autonomous apparatus (1), comprising 
the steps of: 

determining a wheel rotation of a first (17) and a second (18) wheel, 
respectively; and 

calculating a position change based on said first and second wheel rotations and 
a track width (30), characterized by the furtiier step of: 

determining a driving mode (40a-40u) based on said wheel rotations, whereby 
said calculating step is based on an actual track width (30) associated with said 
driving mode (40a-40u). 

2. The method according to claim 1, characterized in that said driving mode 
(40a-40u) is defined by means of rotation velocities of said first (17) and said second 
(18) wheels. 

3. The method accordmg to daun 2, diaracterized in that said driving mode 
(40a-401, 40q, 40s) is defined by a range of ratios between said rotation velocities. 

4. The method according to claim 2, characterized in that said driving mode 
(40m-40p) is defined in that said rotation velocity of said first wheel (17) is within a 
predetermined first velocity range. 

5. The method according to clauns 2 or 4, diaracterized in that said driving 
mode (40m-4()p) is defined m that said rotation velocity of said second wheel (18) is 
witiiin a predeteimmed second velodty range. 

6. The metiiod according to claun 2, diaracterized by five driving modes (40q- 
40u) defined by: 
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forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) wilh equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 
S backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 

forward rotation of said first wheel (17) either alone or in combination with 
forward movement of said second wheel (18)» where die rotation speed of said 
second wheel (18) is lower than Ihe rotation speed of said first wheel (17); and 
10 forward rotation of said second wheel (18) either alone or m combination with 
forward movement of said first wheel (17), where the rotation speed of said first 
wheel (17) is lower than the rotation speed of said second wheel (18). 

7. A calibration method for a positioning device (50) of an autonomous ^paratus 
IS (1), characterized by the steps of: 

aligning said autonomous apparatus (1) in an initial direction; 
turning said autonomous t^aratus (1) hi a first of a number of drivuig modes 
(40a-40u); 

determining an actual total turning angle of said autonomous apparatus (1); 
20 measuring a wheel rotation of a first (17) and a second (18) wheel, 
respectively; and 

calculating an actual track width (30) associated with said first driving mode 
(40a-40u) based on said measured wheel rotations and said determined actual total 
turning angle. 

25 

8. The method accordmg to claun 7, characterized hi that said calculating step hi 
tum comprises the steps of: 

calculating an expected total turning angle of said autonomous apparatus (1) 
based on said measured wheel rotations and a temporary track widtii; 
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calculatii% a difference between said e^cpected and said actaal turning angles of 
said autonomous apparatus (1); and 

determining said actual track widHi (30) as a correction of said temporary track 
width based on said difference. 

5 

9. The method according to claims 7 or 8, characterized in that said driving 
modes (40a-40u) are defined by means of rotation velocities of said &st (17) aM 
said second (18) wheels. 

10 10. The method according to clahn 9, characterized in that said driving modes 
(40a-401, 40q, 40s) are defined by a range of ratios between said rotation velocities . 

11. The method according to claim 9, characterized in that at least one of said 
driving modes (4Qm-40p) is defined in that said rotation velocity of said first "whsd 

15 (17) is within a predeteimmed first velocity r^e. 

12. The method according to daims 9 or 11, characterized in that at least one of 
said driving modes (4Qm-40p) is defined in that said rotation velocity of said second 
wheel (18) is within a predetermined second velocity range. 

20 

13. The method according to claim 9, characterized hy five driving modes (40q- 
40a) defined by: 

forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation velocities; 
25 forward rotation of said first wheel (17) and badcward rotation of said second 
wheel (18) with equal rotation speed; 

backward rotation of said first wheel (17) and forward rotation of said secoiLd 
wheel (18) with equal rotation speed; . 
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forward rotation of said first wheel (17) either alone or in combination with 
forward movement of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower than the rotation speed of said first wheel (17); and 

forward rotation of said second wheel (18) either alone or in combination with 
5 forward movement of said first wheel (17), where the rotation speed of said first 
wheel (17) is lower than the rotation speed of said second wheel (18). 

14. The method according to any of the claims 7 to 13, characterized in that said 
actual tuming angle determining step m turn comprises the step of: 

10 utilizing an operator inpit or an external inpat. 

15. Hie method according to claim 14, charactoized in that said external input is 
a signal generated by detection of a magnetic field. 

15 16. A position determining device (50) of an autonomous apparatus (1) comprising: 
means (51, 52) for detennhung a wheel rotation of a first (17) and a second 
(18) wheel, respectively; and 

calculation means (53) for calculating a position change based on said first and 
second wheel rotations and a track widtii (30), said calculation means bdng 
20 connected to said means (51, 52) for measuring said wheel rotations, characterized 

by 

means (54) for determimng a drivmg mode (40a-40a) based on said wheel 
rotations connected to said calculation means (53), whereby said calculation means 
53 is arranged to base said calculation on an actual track widtii (30) associated with 
25 said diivmg mode (40). 

17. The device according to claim 16, characterized in that said driving mode 
(40a-40u) is defined by means of rotation velocities of said first (17) and said second 
(18) wheels. 
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18. The device according to claim 17, characterized in that said dnviog mode 
(40a-401, 40q, 40s) is defined by a range of latios between said rotation velocities. 

19. The device accoxding to claim 17, characterized in that said driving mode 
S (4Qai-4()p) is defined in that said rotation velocity of said first wheel (17) is within a 

predetermined first velocity range. 

20. The device according to claims 17 or 19, characterized in that said driving 
mode (4Qm-40p) is defined ui that said rotation velocity of said second wheel (18) is 

10 within a predetnmined second velocity range. 

21. The device according to claim 17, characterized by five driving modes (40q- 
40a) defined by: 

forward rotation of said first wheel (17) and forward rotation of said second 
15 wheel (18) with equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with eqoal rotation speed; 

backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 
20 forward rotation of said first wheel (17) either alone or in combination with 
forward movement of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower than the rotation speed of said first wheel (17); and 

forward rotation of said second wheel (18) either alone or in combination with 
forward movement of said first wheel (17), where the rotation speed of said first 
25 wheel (17) is lower than the rotation q)eed of said second wheel (18). 

22. The device according to any of the claims 16 to 21, characterized by position 
calibration means in turn comprismg: 

means (22) for aligning said autonomous apparatus (1) in an initial direction; 



wo 02/075469 



PCT/SE02/00420 



24 

means (21) for causing driving means (60) to turn said autonomous apparatus 
(1) in a first of a number of driving modes (40a-40u); 

means (80) for determining an actual total turning angle of said autonomous 
apparatus (1); 

5 first calculation means (70) for calculating said actual track width (30) 

associated with said first driving mode (40a-40u) based on said measured wheel 
rotations and said determined actual total turning angle. 

23. The means according to clahn 22, characterized in that said first calculation 
10 means (70) in turn comprises: 

second calculation means (71) for calculating an expected total Uuning angle of 
said autonomous apparatus (1) based on said measured wheel rotations and a 
tempoaiy track width; 

third calculation means (72) for calculating a difference between said expected 
IS and said actual turning angles of said autonomous apparatus (1); and 

means (73) for detmnmmg said acUial track width (30) as a conection of said 
tenqwrary track width based on said difference. 

24. A position calibration means of an autonomous apparatus, characterized by 
20 means (22) for aligmng said autonomous apparatus (1) in an initial directio]]^ 

means PLl) for caosmg driving means (60) to turn said autonomous apparstm 
(1) m a first of a number of driving modes (40a-40tt); 

means (80) for determining an actual turning angle of said autonomous 
apparatus (1); 

25 means (51, 52) for measuring a wheel rotation of a first wheel (17) and a 
second wheel (18), respectively; and 

first calculation means (70) for calculating an actual track width (30) associated 
with said first driving mode (40a-40u) based on said measured wheel rotations and 
said determined actual to^ turning angle, said first calculation means (70) being 
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connected to said means (80) for detennining said actual timiing angle and said 
means (Sl» 52) for measuring said wheel rotations. 

25. The means accordmg to claun 24, characterized in that said first calculation 
means (70) in turn comprises: 

second calculation means (71) for calculatmg an eiqpected total tummg angle of 
said autonomous apparatus (1) based on said measured wheel rotations and a 
temporary track width; 

tfakd calculation means (72) fbr calculating a difference between said expected 
and said actual turning angles of said autonomous apparatus (1); and 

means (73) for detemmiing said actual track width (30) as a correction of said 
temporary track width based on said difference. 

26. The means according to clauns 24 or 25, characterized in that driving modes 
(40a-40u) are defined by means of rotation velocities of said first (17) and said 
second (18) wheels. 

27. The means according to claim 26, characterfoed in that said drivmg modes 
(40a-401, 40q, 40s) are defined by a range of ratios between said rotation velocities. 

28. The means according to daim 26, characterized in that at least one of said of 
driving modes (AOm-AOp) is defined m that said rotation velocity of said first wheel 
(17) is withm a pred^^mined first velocity range. 

29. The means accordmg to claims 26 or 28, characterized in that at least one of 
said of drivmg modes (4Qm-4()p) is defined hi that said rotation velocity of said 
second wheel (18) is within a predetemoined second velocity range. 

30. The myeans according to claun 26, characterized by five driving modes (40q- 
40u) defined by: 
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forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 

backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 

forward rotation of said first wheel (17) either alone or in combination with 
forward movement of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower than the rotation speed of said first wheel (17); and 

forward rotation of said second wheel (18) either alone or m combination with 
forward movement of said first wheel (17), where the rotation speed of said first 
wheel (17) is lower than the rotation speed of said second wheel (18). 

31. The means according to any of the claims 24 to 30, characterized ui that said 
means (22) determining said actual total tuming angle of said autonomous apparatus 
m turn comprises operator ii^ut or external ii^t means. 

32. The means accordmg to claim 31, characterized in that said external ii^ut 
means is a magnetic field detector. 

33. The means according to clahn 32, characterized in that said magnetic field 
detector is a Hall soisor (23, 24). 
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